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LightFinder 





a Stamp-powered Lego vehicle 





A compact and pro- 
grammable little 
robot vehicle may be 
built from ingredi- 
ents like the famous 
BASIC Stamp, 
assorted electronic 
parts, and Lego 
bricks and motors. 
The LightFinder 
described in this arti- 
cle proves that intel- 
ligence is the key- 
word in elementary 
cybernetics. 


Specification 


im 9-V battery powered 
m» [W0 motors 


im Two front/side contact switches 


im Two light sensors 

iw TWO infrared light sensors 
im Programmable in BASIC 
m 256 bytes program code 
ium Program written on PC 


Cybernetic models 
(electronically pow- 
ered systems simu- 
lating living organ- 
isms) were pub- 
lished on several 
occasions in Elektor 
Electronics. How- 
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ever, in retrospect 
these systems were complex, slow and 
bulky. The availability of advanced 
microcontroller has made it much eas- 
ier to build an small vehicle doted 
with a basic amount of artificial intel- 
ligence (Al). The  LightFinder 
described in this article is a fine edu- 
cational project, with a V.1 BASIC 
Stamp from Parallax acting as the 





‘brains’. The project also comprises a 
compact printed circuit board con- 
taining all I/O components, two Lego 
motors with built-in reduction gear, 
and some Lego building blocks. 
Throw it all together and you are look- 
ing at a miniature robot vehicle capa- 
ble of finding its way to alight source, 
or (by reprogramming), avoid a light 
source, despite obstacles in its path. 

Thanks to the use of the BASIC 
Stamp as the heart of the system, the 
behaviour of the LightFinder is readily 
changed to meet your own require- 
ments. No knowledge of source code 
programming is required, the Stamp 
module is programmed in BASIC using 
your PC. 
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STRUCTURE 

The block diagram shown in Figure 1 
shows the elementary structure of the 
LightFinder cybernetic model. The 
vehicle is powered by two compact dc 
motors with internal reduction gear. 
The sensors are a pair of LDRs (light- 
dependent resistors) for light/dark 
detection, a pair of infrared sensors for 
distance measurement, and a pair of 
switches to detect obstacles in the way. 

The LightFinder’s intelligence is 
vested in a ready-made BASIC Stamp 
Version 1 module from Parallax, Inc. 
The LightFinder communicates with 
you via beeping sounds from its on- 
board piezo-buzzer. The Lego motors 
are driven by an integrated motor dri- 
ver IC, which is also shown in the 
block diagram. 

The two infra-red 
sensitive ‘eyes’ of the 
LightFinder are pretty 
advanced electronic cir- 
cuits capable of detect- 
ing objects by illuminat- 
ing them with a modulated infra-red 
light source. Depending on the sensi- 
tivity set by the user, these ‘eyes’ are 
capable of detecting large obstacles at 
a distance of about 20 cm. 


PRACTICAL CIRCUIT 

The drauit diagram of the LightFinder’s 
control system is shown in Figure 2. 
The heart of the drcuit is formed by the 


Figure 1. Block diagram 
of the LightFinder cyber- 
netic model. 


PIC-based BASIC 
Stamp connected to 
K5. Because the 
BASIC Stamp is used 
as aready-made modulein this project, 
its operation is not discussed in this arti- 
cle. All electronic circuits that link the 
processor to the real world is connected 
to the pins of K5. Because of the proces- 
sor’s rather limited I/O capacity, 
switches S1 and S2 are 
connected to an ana- 
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processor is capable of measuring the 
value of a resistor, potentiometer or 
LDR by connecting the relevant resis- 
tance in series with acapadtor, and then 
establish the RC time produced by the 
combination. Because the RC time mea- 
sured on PC4 will change when S1 is 
closed (R = 16.8kQ) or S2 is dosed (R = 
28.8kQ), the system software is capable 
of detecting whether the left-hand or 


logue input, PC4, via 
a voltage divider. The 





right-hand 
Figure 2. The circuit diagram of bu mper 
the LightFinder’s electronics is no switch was 
more than a collection of sensors. closed by 


All computing power resides in 
the BASIC Stamp module. 


9ve(+) G)5V 
Let) Te 


100n| 10u |25V 10u | 25V |100n 











BASIC STAMP 








OUT3 OUuT1 


L293D 














1+ L F 
2) ae 5 
3 ake > 
113| 4 m 
ZTR 1S471F 
Elektor Electronics 4/99 


D: D ft 
2 1 2 
<+ 
> + 
> + 3 < 
iR mL [a [+ 
IS471F 990035 -- 12 


55 













Infrared light 
emitting diode 


FS 


Mh 


Voltage regulator 


Comparator 











Oscillator 







Figure 3. Internal struc- 
ture of the IS471F from 
Sharp. Two of these 
sensors act as the 
LightFinder’s ‘eyes’. 


the LightFinder run- 
ning into an obstacle. 
When both switches are 
open, the Stamp mea- 
sures a resistance of 
38.8 kQ. Thetwo LDRsare ‘read’ in the 
same way by connecting them in series 
with a 100-nF capacitor. 


INFRARED EYES 
The LightFinder uses an ingenious 
method to determine its distance from 
a large obstacle such as a wall. Infrared 
light is employed for this function, in 
particular, an 1S471F integrated circuit 
from Sharp. The block diagram of this 
IC is shown in Figure 3. More techni- 
cal details, in particular, on the opto- 
electrical characteristics, may be found 
on this month’s D atasheets. The 1S471F 
contains a complete modulator, 
demodulator, voltage regulator and an 
oscillator. The latter is used to drive an 
external infrared emitting diode (IRED) 
via a buffer. The light emitted by the 
IRED is detected again by the on-chip 
receiver diode. The resulting signal is 
first amplified and then converted into 
a digital pulse-shaped signal by means 
of a comparator. The integrated syn- 
chronisation detector and demodula- 
tor circuit then compare the received 
signal with the pulse signal applied to 
the sender diode. If the 
two signals are equal, 
the digital output of the 


Figure 4. A special IC, 
the L293D, is used to 


IC (pin 2) is enabled. 
By adapting the resis- 
tance in series with 
the IRED, the ‘trans- 
mit power’ may be 
increased or decreased. In this way, the 
optical sensitivity may be controlled 
within certain limits. The configuration 
used in the circuit allows a large object 
at a distance of about 20 cm to be 
detected without problems. 

The drcuit may be powered by volt- 
ages between 4.5 V and 16 V, so that 
battery voltages of 9V or 12 V are good 
options. The pulse repeat time is typi- 
cally 130 (s (approx. 8 kHz), and the 
pulse on-time is 8 (s, so that the battery 
is used economically. The LightFinder 
has two infra-red eyes so that objects at 
either side of the vehicle may be 
detected. 

The buzzer is a simple piezo-electric 
beeper. It is controlled via port line P2 
of the BASIC Stamp. The tone fre- 
quency is programmable over a wide 
range: approx. 95 Hz to over 10 kHz. 

Theintegrated motor driver, a Type 
L293 from SGS-Thomson (and second 
sources) allows the hardware to be 
reduced considerably. Asshown by the 
internal diagram in Figure 4, the IC 
contains four power drivers. These are 
capable of supplying a continuous 
diret current of 
600 mA or 1.2 A peak. 
On-chip flyback 


drive the motors. 
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Demodulator 
circuit 


O Vec ( Power supply) 
O Vo ( Signal output) 


C=0.33uF 
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diodes protect the IC outputs against 
voltage surges caused by the switching 
of inductive loads (such as the motor 
coils). Because the inputs of the L293 
are TTL compatible, they can be 
directly linked to the microcontroller 
outputs. An on-chip thermal protec- 
tion circuit disables the buffer if an 
overload condition arises. 

The two motors of the LightFinder, 
M1 and M2, are totally controlled by 
just three processor control lines. Port 
lines PO, P1 and P2 form the link 
between the controller and the motor 
driver. PO carries the common enable 
signal for the Lego motors. If the enable 
line isinactive (low), the power drivers 
in the L293 are switched off, or, more 
precisely, their outputs are switched to 
high-impedance. In this state the cur- 
rent consumption is minimized. 

Port lines P1 and P2 convey the 
motor direction information. Because 
the buffers are set up in a bridge con- 
figuration, an inverter is included 
between the two drivers assigned to 
one motor. This is done to make sure 
that the two motor terminals are 
always polarized or, of course, at OV. 

The power supply has been kept as 
simpleas possible, with all parts capable 
of working at 9 V connected directly to 
the battery. The motor driver and the 
BASIC Stamp can only work at 5V, and 
they receive their supply voltage from 
regulator IC3. Attentive readers may 
have noticed that the circuit diagram 
indicates a supply voltage of 9.6 V. The 
reason is that this voltage is supplied 
by some rechargeable batteries that can 
be used as substitutes for 9-V blocks. 
Rechargeable batteries were success- 
fully used during the entire develop- 
ment period of the LightFinder, with 
excellent results, and to stay keep our 
governors happy as far as budgets are 
concerned! In use, the circuit draws 
more than 100 mA when the vehicleis 
on the move. 


ELECTRONIC 
CONSTRUCTION 

The copper track layout and compo- 
nent overlay of the PCB designed for 
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COMPONENTS LIST 


Resistors: 

R1 = 22kQ 

R2 = 10kQ 

R3 = 6kQ8 

R4,R5 = LDR 

P1,P2 = 250Q preset, vertical 


Capacitors: 

C1-C4,C6,C10,C11 = 100nfF, raster 
5mm 

C5,C7 = 330nF 

C8,C9 = 10uF 25V radial 

C12 = 100uF 16V radial 


Semiconductors: 

D1,D2 = IRED, e.g. LD271 
IC1 = 74HC04 

IC2 = L293D 

IC3 = 78L05 


Miscellaneous: 

Bz1 = piezo buzzer (passive) 

K1,K2 = IS471F (Sharp) 

K3,K6-K9 = 2-way SIL socket 

K4 = 3-way SIL header 

K5 = 14-way SIL socket 

M1,M2 = motor, see inset on Lego 
parts 

$1,S2 = microswitch, 1 make con- 
tact 

BASIC Stamp, V. 1 (Milford Instru- 
ments) 

PCB, order code 990035-1, see 
Readers Services page 





the LightFinder may be found in Fig- 
ure 5. This board is available ready- 
made through the Publishers’ Readers 
Services. It is plain to see that his board 
has to be cut in two, and we recom- 
mend doing this first. The two bumper 
switches S1 and S2 are fitted on the 
board with holes only. The photograph 
of the prototype shows the practical 
realization. Two pieces of metal wire 
are used to make the actual ‘bumpers’ 
that serve to extend the contact range 
of the switches. The wires are cut and 
bent such that they extend a little 
beyond the wheels. In this way, the 


Lego bricks & 
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Figure 5. Copper track 


bumpers allow obsta- 
cles beside the vehicle 


to be detected also. LightFinder PCB 
Using two piecesof | (board available ready- 
massive wire, the made). 


board holding the 
switches is fitted at 
right angles on to the main board. 

The BASIC Stamp is inserted in SIL 
socket K5 — the component side 
points in the direction of IC2. The 
Stamp computer may be programmed 
later using the Parallax programming 
cable hooked up to the PC and 3-way 
SIL header K4. 

Pay attention when mounting the 
sensors on to K1 and K2. As indicated 
by the component overlay, the pro- 
truding part of the case should point to 
the rear of the vehicle. The infrared 
light produced by the associated IRED 
(D1 or D2) then reaches the sensor face 
via the reflecting object. The behaviour 
of the IR sensors may be fine tuned as 


9V battery box: 


layout and component 
mounting plan of the 


follows: with the motors 
disconnected, set the 
IRED power presets 
(P1, P2) to maximum 
resistance. Then mea- 
sure the voltage at the 
sensor output (pin 3). 
Next, place a fairly large obstacle at the 
desired distance from the sensor, and 
turn the relevant preset (P1, P2), until 
the output goes low. Turn the sensors 
sideways a little — they should not 
look straight ahead, and horizontally 
they should remain in line with the 
associated IRED. 


MECHANICAL 
CONSTRUCTION 

The prototype of the LightFinder was 
built mainly from Lego bricks and 
other parts. The vehicle is powered by 
two compact 9-volt dc. motors with 
internal gear reduction boxes. The 
‘floor plate’, nose wheel and battery 
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other parts 


The version of the LightFinder as shown on this month's 
front cover was built from standard Lego bricks and parts. 
Because some of the special parts may be difficult to find 
individually, an overview is given of the relevant order 
codes. Further information may be found on Lego’s won- 
derful website at www.lego.com. 


Micro motor: 5119 
Small low-profile tyres: 5268 
Nose wheel: 5050 
Hinge: 5388 
Cross axles: 5226 
Plates with wires: 5311 


Items 5050, 5388 and 5226 are part of the Plane Acces- 
sories Set. 

Itshould be noted that two motors and two cable sets have 
to be ordered. In addition to these components you will 
also require a base plate and a few standard bricks. Any- 
one who has ever worked with Lego should have these 
available. 

Fora copy of the Lego Service brochure, or information 
on Mail Order Service for Lego sets, contact 


Consumer Service 

LEGO UK Limited 

Ruthin Road 

Wrexham LL13 7TQ 

Main Switchboard Number: (01978) 290900 
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box are also from the Lego ‘Technic’ 
series. This month’s cover photograph 
shows the result of one evening of 
‘vehicle building for the young’. If you 
want to copy our construction, the rel- 
evant parts descriptions and Lego 
order numbers may be found in the 
inset. 

Users of Meccano, Knex or Fischer 
Technic parts may easily produce simi- 
lar constructions of the vehicle, the 
general structure being uncritical. If the 
vehicle is made much larger or from 
different parts (metal), it will probably 
become so heavy that you have to 
resort to six (rechargeable) AA-size bat- 
teries instead of the 9V PP3 (6F22) 
block. Non-rechargeable AA batteries 
have a much larger capacity than a 9-V 
PP3 (up to 1500 mAh), and they will 
typically last longer. 

Other motors may be used, as long 
as their current consumption does not 
exceed the 600-mA limit imposed by 
the power drivers in the L293. 

Special connecting cables are avail- 
able for the Lego motors. If these are 
cut, you have two connecting cables, 
which may be soldered in the desig- 
nated sockets (M1 and M2). 

The wires of the LDRs will be long 
enough to give these devices a far view 
when positioned high on the vehicle. 
Be sure to isolate the wires, though, 
and bend them carefully only if you 
need to adjust the viewing direction. 
The choice of the LDRs is not particu- 
larly critical. If necessary, the Alt-P’ 
option in the control software 
(Stamp.exe) may be used to adapt the 
sensitivity to the LDR characteristics 
(see the Stamp manual for further 
details). 


SOFTWARE 

The BASIC control program developed 
for our prototype of the LightFinder is 
listed in Figure 6. This listing is 
intended to get you started. Because 
the program is not too extensive, it is 
easily typed into the Editor utility of 
the Stamp.exe program. 

The BASIC Stamp kit comes with 
programming tools, a programming 
cable, a manual and a carrier board. 
This kit may be ordered directly from 
Parallax, or through authorized dis- 
tributors. Readers in the UK should 
contact Milford Instruments, South 
Milford, Leeds, tel. (01977) 683665, fax 
(01977) 681465, email 
info@ milinst.denon.co.uk, web site at 
www.milinst.denon.co.uk. 

There is a cheaper alternative to the 
complete kit, however: The Parallax 
web site at www.parallaxinc.com allows 
you to download the complete Stamp 
manual as a ‘pdf’ (Adobe Acrobat 
Reader) file, as well as the develop- 
ment software. If you feel you are able 
to make your own programming cable, 
then all you have to order is one BASIC 
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Figure 6. Listing of the BASIC pro- 


gram that makes the LightFinder 


come alive. 


Program to control a LEGO-robot (type NANOBOT) 


NANO BOT. BAS 08.03.98 
Author Gerhard Nocker 
1998 Copyright Elektor, Beek (L), 























The Netherlands 








-== Port Pin Assignment ------+++++++e reer ee eee eee eee eee eee 
"Port Function ype 

"Pin 0 Motor current /1 == on/off Di gOut 
"Pin 1 Right motor [1 == back/fw Di gOut 
"Pin 2 Left motor (buzzer) /1 == back/fw Di gOut (sound) 
"Pin 7 Switch right/left Anin 

'Pin 4 Right IR obstacle det. /1 == obstacle/free Di gin 

"Pin 5 Right LDR Anin 

'Pin 6 Left LDR Anin 

'Pin 3 Left IR obstacle det. /1 == obstacle/free Di gln 
Cassan Remark ----++eee eee er eee eee eee eee eee eee eee eee eee 
"Pin 2 is also used to produce sounds. Both motors will be halted. 
‘The direction bit of the left motor controls the buzzer. 

‘There are four different sounds 

‘Obstacle on the right side: high/low 

'Obstacle on the left side: low/ high 

‘Too much light: high 

‘Too dark: low 

tenes Declaration of constants ---------+++++eee eee ee ee ee eee eee 








sw pin=7 
sw_scale = 33 
symbol ri_ldr = 5 
i_ldr_sc = 82 
symbol le_ldr = 6 
e ldr_sc = 82 
_thres = 15 
symbol halt = 0 
wd = 7 
backw 
Ri ght 
symbol Left = 3 





1 
5 


w= bito 
w= bitl 
ag = bit2 "NOT USED 
ag = bit3 

flag = bit4 

sw_ va 
symbol |wre = b5 
symbol Iw_li = b6 
duration = w4 
Rnd = w5 


symbol b 


1 
an m mua u 











<.. Program start --------------+---- 
‘port bit 7..3 input, bit 2..0 output 


dirs=%00000111 
r_sw = 0 
l sw=0 


- Declaration of variables ------- 
‘storage for right switch (on/off) 
"storage for left switch (on/off) 


‘switch input at port pin 7 
‘switch scale factor 


b4 'storage for analog switch value 


If a switch is opened/closed at power up the robot wil 


search/avoid ligh 











pot sw pin, swscale, sw_val 
b flag =1 
If sw val < 240 Then Ibil 
goto loop 
I bl 1: b flag = 
|_flag = 
trees Program main 100p --------+++-+- 
Loop: pot ri_ldr, ri_ldr_sc, Iw_re 
pot le_Idr, le_ldr_sc, Iw 


‘read switches 


‘read right LDR 
‘read left LDR 
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contd: 


forw: 


contl: 


conta: 


cont 3: 


turn: 


wait: 


clearfl: 


w 
w 
b8 
b9 


_re=lw_re min |_thres 
_lislwli min |_thres 
=lwli - |_thres 
= lwre - |_thres 


wre < 200 Then clearf 


e < b8 And b_ flag = 0 Then turn_! ‘compare light 
i < b9 And b_ flag = 0 Then turn_r ‘and 

e < b8 And b_flag = 1 Then turn_r ‘behaviour 

i < b9 And b_flag = 1 Then turn_| 


Stamp module Version 1. 

The BASIC Stamp is ready for pro- 
gramming once the control program 
has been typed in using Stamp.exe, the 
programming cable is connected at 
both ends (LightFinder and PC), and 
the LightFinder is switched on. Note 
that Stamp.exe is a DOS program 
whose Upload function will only work 








pins 
goto 
pins 
goto 


switches and IR obstacle detection 
SW_pin, sw_scale, sw_val 





S 
S 
S 





r_sw 
SW 
GoTo 
T_SW 
_SW 





pins 
paus 
pins 
paus 
pins 
lf | 
soun 
pins 
G 





soun 
pins 


rand 
dura 


pause duration 


= fwd 
switc 





h 


|_thres And I wl 


= Right 


loop 


= Lef 
loop 


w_val 
w_val 
w_val 


= 0 
Poel 
contl 
snl 
=0 


= ha 
e 10 


t 


> 180 And sw_val 


> 240 Then Loop 


t 


= backw 


e 15 
= ha 
SW = 


t 
1 


Then cont2 


d 2,(123, 40,110, 40) 


= Le 
cont3 





t 


d 2,(110, 40, 123, 40) 
= Right 





om Rnd 


tion = 1000 + b10 


pins = halt 


paus 
goto 


e 1000 
loop 


pins = halt 


Sound 2,(125, 30) 
pins = Right 
tion = 2800 
pause duration 


dura 


pins 
pins 
paus 


GoTo switch 


pins 


sound 2, (80, 30) 


paus 
Po 


= ha 
= fwd 
e 300 


= ha 


e 100 
ag = 1 





t 


t 


0 


GoTo switch 


ead, 
GoTo 


ag = 0 
conto 
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= |_thres Then turn ‘too much light 
255 And Iw_li = 255 And |_flag = 0 Then wait ‘too dark 


‘read switches 
< 240 Or pin3 = 0 Then sl 
< 180 Or pin4 = 0 Then sr 


properly in ‘real DOS’ mode (i.e., notin 
a Windows DOS box). 

At this point give your cybernetic 
model a test spin — see if it can find a 
light source! If you are not satisfied 
with its behaviour, the control program 
may be modified to make the model 
respond differently to the various sig- 
nals it is capable of detecting. If you 
have ideas for improvements, let us 
know! 


(990035-1) 





Figure 7. Photo- 
graph of our proto- 
type. The mechani- 
cal construction 
consists of Lego 
bricks and parts. 








